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Abstract 

Parallel robotic mechanisms have good accuracy, high 
stiffness and large payload to weight ratio compared 
to the traditional serial mechanism. This paper 
compares two simple constant gain control schemes 
for a parallel robotic mechanism actuated by hydraulic 
cylinders. One of the control schemes which will be 
referred to as a "rate based scheme" uses the position 
and rate information only for feedback. The other 
control scheme referred to as the "force based scheme" 
feeds back the force information also. It is shown 
that for parallel robots with hydraulic actuators the 
response of the end-effector can be improved by using 
the force information from the actuators without 
adding any extra computational burden. The force 
based control scheme can also be easily modified to 
control the forces on the end-effector. The control 
scheme has been implemented in a computer 
simulation and the results are presented in the paper. 

Introduction 

Recently, there has been a lot of activity in the area 
of parallel mechanisms (Figure 1). Parallel 
mechanisms are able to overcome many of the 
shortcomings of serial mechanisms. They have a 
high stiffness, large payload to weight ratio and good 
accuracy compared to serial mechanisms. The best 
known application of parallel mechanism is the 
Stewart Platform which is used in aircraft simulators. 
These mechanisms also have potential for application 
in zero/partial gravity simulators, assembly tasks and 
precision machining. 

Previous research in parallel mechanisms has been 
focused on the kinematics of the mechanisms. The 
general kinematic considerations are examined in [3], 
[4], [7], [13] and [14], The direct position kinematics 
of some special parallel mechanisms are given in [S], 
[9] and [10]. There is little research in the dynamics 
and controls of parallel mechanisms. Some of the 
dynamics issues are examined in [IS]. 

An important part of assembly tasks is the control of 
interaction forces between components. In other 
applications such as partial/zero gravity simulators, it 
will be required that the actuators apply constant 
forces through the cento* of mass of the end effector. 
In this application, again the forces on the end 
effector will have to be controlled. The rate based 


scheme does not offer any capability for controlling 
forces. The force based control scheme developed in 
this paper can easily be modified to control these 
forces. This ability is crucial to the successful 
application of parallel mechanisms to assembly tasks. 

The parallel mechanism analyzed in this paper is 
shown in Figure 1. It is a six degree of freedom 
mechanism. The top member and the base member 
are connected by six limbs. Each limb is a hydraulic 
cylinder with universal joints at each end. The piston 
and the cylinder are allowed to rotate with respect to 
each other. Thus each limb is a six degree of freedom 
serial chain with one actuated prismatic joint The 
universal joints in the top member are located in a 
plane and the universal joints in the base member are 
also located in a single plane. 

The first section of the paper examines the linearized 
dynamic model of the fully parallel mechanism. 
Using the linearized model, the control schemes are 
studied. The following section describes the control 
scheme in detail. The next section deals with the 



Figure 1. Special Parallel Mechanism (Each limb 
consists of universal joints at each end and a 
cylindrical joint between them; the prismatic joint is 
actuated). 
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complete dynamic simulation of the parallel 
mechanism. To simulate the dynamics of the 
mechanism, it is essential to have an efficient scheme 
for the direct dynamics problem. This will help in 
reducing the computational time required for 
simulation. The models for the hydraulic cylinders 
and the servolvalves are given in Appendix B. The 
results are discussed in the last section. 


Linearized Rigid Body Model 

In fully parallel mechanisms ([14]), the joint rates and 
the end effector motion are related by the following 
equation: 


L = H 


T 



( 1 ) 


where 

L= Vector consisting of the joint rates. 

H = 6x6 matrix. 

(0 = angular velocity of the end effector. 

p. = velocity of the point on the end effector 

coincident with the origin. 

The matrix H is a purely geometric quantity. The 
columns of the matrix H are the wrench axis of the 
joints. 

For parallel mechanisms, static force decomposition 
equation is: 


R 

r 


= HF 


( 2 ) 


where 

R = Forces acting on the end effector. 

T = Moments acting on the end effector about the 
origin. 

H = 6x6 matrix 

F = ForcesA'orque’s at the joints. 


It will be assumed without any loss of generality that 
the origin of the fixed coordinate system is located at 
the nominal position of the center of mass of the end- 
effector. 


The current approach, based on the rate control 
scheme, is to control the joint lengths in the parallel 
mechanism. Using this scheme, current position of 
the end effector is compared to the desired position. 
The error in the position is converted to an error in 
the length of the limbs. The limbs are then 
individually controlled to eliminate this error. This is 
achieved by applying forces in the limbs that are 


proportional to the error in the limb lengths. This is 
given by the equation: 

F = -K p L - K V L (3) 


where 

L = error in the limb lengths. 

The equation of motion of the end effector is given by 
(ignoring the non-linear toms): 



where 

M = Diagonal matrix with the mass of the end 
effector as the diagonal term. 

J = Moment of inertia matrix at the current position, 
p, 0 = small errors in position and orientation of aid 
effector. 


Using equations (2), (3) and (4), the response equation 
is (ignoring the actuator model): 



+hk v h t 
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(5) 


The gain matrices in the above equation, K p and K v 
are diagonal matrices with constant terms (the 
cylinders are controlled independently with constant 
gains). Clearly, the response depends on the matrix 
H, which depends on the position of the end effector. 
This is undesirable. It is also not obvious from the 
above equation, whether an increase in the gains 
would lead to an improvement in the response of the 
mechanism. Increase in the gains might lead to 
deterioration in the response due to the structure of 
the H matrix. Further, increasing the gains, leads to 
a shift in all the closed loop poles of the above 
system. The fast poles as well as the slow poles are 
moved simultaneously. This leads to a marginal 
improvement in the response of the system with large 
changes in the gains. There is also die possibility of 
exciting the higher order dynamics due to the presence 
of fast poles (as a result of increase in gains). 

As opposed to the above rate based scheme, in the 
force based control scheme, the force is controlled in 
each limb. The error in the current position of the 
end effector is fed back as error in the forces exerted 
by the limbs. This is given by the equation: 


R' 

= -K„ 

P 

- K v 

y 

r 

P 

0 


0 
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The force to be produced by the actuators at the limbs 
is given by (equation (2) and (6)): 




+ K, 


(7) 


The response equation is now given by (combining 
equations (4) and (6)): 


The above scheme can also be easily adapted to 
control the forces on the end effector. The direction 
in which fences are to be controlled can easily replace 
the position errors in equation (6). This would 
effectively control the forces in those directions. 

Dynamic Simulation and Control Scheme of the 
Parallel Mechanism 



In a simple implementation of the above scheme, K p 
and K v can be chosen as diagonal matrices with fixed 
diagonal toms. The response equations are now to a 
large extent position independent and decoupled. The 
response does not depend on the H matrix. The 
coupling and the position dependency in the above 
equation will come from the J matrix. This response 
equation is an improvement over the previous 
scheme. The closed loop poles can be assigned 
independently in the above scheme and the response 
improved without a corresponding large increase in 
the gains. 


A rigid body dynamic model was developed for the 
parallel mechanism for simulation in MATRIXX. 
Some of the assumptions made for the dynamic 
model are as follows. The limbs were assumed to be 
axisymmetric. The friction losses in the spherical 
and revolute joints were assumed to be negligible. 
The prismatic joint in the cylinder was assumed to 
have viscous losses and the damping coefficient was 
adjusted to obtain a response that closely 
approximated the response from the actual 
mechanism. The model for the hydraulic cylinders 
consists of a leakage term which is assumed to be 
proportional to the pressure difference in the cylinder 
(assuming that the leakage flow is laminar). The 
model for the servovalves was taken from [8]. 



Figure 2. Block Diagram for Rate Based Control Scheme. 
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Figure 3. Block Diagram for Force Based Control Scheme. 


852 











The block diagram for the rate based control scheme 
is shown in Figure 2. In this control scheme, the 
hydraulic cylinders were controlled by dual stage 
servovalves. Within the servovalve, the spool 
position is fed back to the electromagnet with a 
spring. The block diagram for the servolvalve is 
given in Appendix B. The error in the position and 
the velocity are fed back to the current in the 
servovalve. The current in the servovalve is given 
by: 

i = -k p Ie L -k v Ie L (9) 

where 

i = 6x1 vector, 
kp, k v = constants. 

I = 6x6 identity matrix. 
eL = error in limb lengths. 
e L = error in limb length rates. 

A decoupled controller with constant gains is chosen 
for the controller because the gains are associated with 
the hydraulic cylinders. Since all the hydraulic 
cylinders are identical, the gains are kept the same for 
all the cylinders. 

The block diagram for the force based control scheme 
is shown in Fig. 3. In this control scheme, the 
cylinder woe controlled by a proportional servovalve. 
It was found that the spool position feedback in the 
dual stage servovalve inhibited the response of the 
mechanism. The maximum spool opening from the 
servovalve was the same in both the valves to ensure 
that a fair comparison could be made in both the 
schemes. 


The desired force in each of the limbs is given by: 



where 

K p , K v = Diagonal constant matrices. 

e p = error in position. 

e p « error in velocity 

ee = error in angular position. 

eg = error in angular velocity. 

The gain matrices K p and K v are chosen to be 
diagonal matrices. At the current location of the end- 
effector, the off diagonal terms could have been 
chosen to decouple the system. This decoupling 
however, would not be possible for the complete 
workspace due to the change in the inertia matrix. 


The error in the desired force in the limbs given by 
equation (10) and the actual force in the cylinder is fed 
back to the spool. The position of the spool is then 
given by: 

X,=k f e f (11) 

where 

kf = constant 

ef = 6x1 error vector in the forces. 

The gain for the force controller are kept the same for 
all the cylinders, since the cylinders are identical. 

Rigid Body Dynamic Model 



Figure 4. Parallel mechanism with a single limb and 
the variables. 

The six degree of freedom parallel mechanism shown 
in Figure 1 consists of 13 rigid body elements. The 
six equations of motion can be obtained for each 
element, resulting in a large matrix (in this case 
78x78 matrix) equation. This equation will be 
computationally expensive to solve. In the following 
section, a compact 6x6 matrix equation for the 
dynamics of the parallel mechanism is obtained. This 
would result in substantial savings in the 
computational time for the simulation. 

The convention followed in the rest of the paper is as 
follows. All vectors and matrices are in bold letters. 
The superscript on the top left hand comer of a vector 
denotes the coordinate system. A superscript "t" 
refers to the fixed coordinate system coincident with 
the coordinate system attached to the top member and 
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"li" refers to the fixed coordinate system coincident to 
the coordinate system attached to the ith limb. No 
superscript signifies the fixed world coordinate system 
attached to the base member. 


The equations of motion of the top member are given 
by: 

M‘a = -X‘F i3 +M t g 
i 

J t a = -E( , q i x t F i 3 + , T i3 }f t (DXj , a) (12) 

where 


m 

0 

O' 

0 

m 

0 

.0 

0 

m 

K 

- 

-J*y 

- J *y 


J y 

-Jxz 


-Jyz 


'p'KklO 0 -g] T 
g = acceleration due to gravity. 

*Fi 3 = force applied by the top member to the ith 
limb. 

l Ti 3 = Torque applied by top member to the ith limb. 
*qi = position of the ith force. 

ko = angular velocity of the top member in the top 
coordinate frame. 


In the above equations, the forces are unknown. 
These forces are applied to the top member by the 
limbs. The additional equations will come from the 
dynamic analysis of the limbs. These dynamic 
equations will be in the form: 


1, a i3 = 1, R|( , a-qX t a+t) 


(14) 


where 


0 


q x= 


*Qiz 

-V 


Qiz Qiy 

o -‘qix 

‘q« 0 


t = 


-V ( y w, ( 1 <D Z *q z +‘ (Oy *q y ) 

-qiyl^z+^xVwylX^x+'Wz'qz) 

- l qiz( t w*+ t h)? y w z ( \ t q y +‘ ‘q* ) 


Combining (13) and (14) and rearranging terms: 

[I 3 x 3 ” qX (‘a] =tRl ‘ Dl,RtlFi3+tRlldi (15> 


The above constraint equation can be obtained for 
each limb. This will give 6 such equations. 

Another set of constraint equations can be obtained 
for Tj3. The angular accelerations of the upper part 
of the limb and the top member are related by: 


r - 1 


1 

Hi 

0 

«-* 

1 

. 7 

i 

=1 *Rt 

* a y 

.‘ a *_ 


(16) 


The top two members of the above vector equation 
are not important and thus are left blank. This 
equation can be combined with the last equation in 
equation set (16) to get: 


** a i3 = D i 1 *F i3 +d i (13) 

where 

ai 3 = acceleration of the ith universal joint. 

Fy = force transmitted across the ith universal joint. 

The development of the above equations for the 
parallel mechanism under consideration here are given 
in Appendix A. 

The acceleration of the joint and the center of mass of 
the top member are related by: 


‘T* =-*Ri, 


0 0 0 
0 0 0 
0 0 J i2z. 


r R t‘a 


(17) 


The equation of motion of the top member under the 
influence of forces Fft are given by (12). Equation 
(IS) can be used to eliminate forces Fi3 from 
equation (12) and equation (17) can be used to 
eliminate To from equation (2). This leads to: 
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( 18 ) 


I qX‘R! Dr U ‘R t lr t ■ 

i-i,6 K a 

1+ ^(‘Rl.Jilz 1 '^ -qX‘Ri Dr U ‘R t qX) !>. 


M+ I % Df ll ‘R t 
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I ( l R, DJ’ 1 d i - t Ri Dj -1 ** R t t) +M l g 
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I (qX l Rj Dj' 1 d-qX t R 1 Dj' 11, R t t\f t oi)Xj t Ci) 

.i-1,6 ' ' ‘ ' 

These equations can be used to solve for the 
accelerations of the top member. These are a very 
efficient form of the dynamic equations. 

The above accelerations are in the coordinate system 
fixed to the top member. They can be transformed to 
the accelerations in the fixed coordinate frame by a 
simple coordinate transformation. Integrating the 
accelerations will give the velocity of the top 
member. The angular velocity of the top member can 
be used to calculate the euler angle rates using the 
following equation: 


a" 


Cosy 

Siny 

0 

P 

= Seep 

-Siny CosP 

Cosy CosP 

0 

_Y_ 


Cosy SinP 

Siny SinP 

Cosp 


The above rigid body model was combined with the 
dynamic models for the hydraulic cylinder and the 
servolvalves. The details of these models are given in 
Appendix B. 

Discussion of Results 

The results from the simulation are shown in Figures 
(5)-(10). The top member was moved along the z- 
axis from a initial position of (0,0,140.0) to a final 
position of (0,0,140.2). while keeping the orientation 
fixed. The move was commanded at 0.1s from the 
start of the simulation to allow for the system to 
attain equilibrium. The gains for the controller were 
obtained by modifying the gains obtained from a 
linearized analysis. 

The results from the rate based scheme are shown in 
Figures (5)-(7). The final position is obtained in 
0.122s. The move in the z-direction induces 
oscillation in the x and y directions. If the gains are 
increased any further, the system will become 
unstable. 

The results from the force based scheme are shown in 
Figures (8)-(10). The final z-position is reached in 
0.058s. This is a 53% improvement in the step 
response of the mechanism in the z-direction. The 
gains in this system can be individually adjusted for 


each direction and thus the response in the x, y and z 
direction can be individually tailored. There is also a 
significant steady state error in the response. This is 
an expected error due to the weight of the top member 
and the upper part of the limbs. This error can be 
removed by adding a feedforward term to the 
controller. The mechanism in the beginning of the 
move can estimate the weight of the top member and 
then use this information in the feedforward term. 

Conclusions 

A simple constant gain force control scheme has been 
devised for the parallel mechanisms. This scheme is 
easy to implement and is better suited to parallel 
mechanisms than rate control schemes. The force 
control scheme requires the computation of H~1 while 
the rate control scheme uses the inverse position 
kinematics. The H matrix can be inverted 
symbolically to save on computational expense. 

The preliminary results indicate that the force based 
control scheme will improve the response over the 
rate based control scheme. Further work, however is 
required to reach any comprehensive conclusions. 
There are important unanswered questions about the 
effect of the position of the end-effector and the 
payload mass on the response of the mechanism. 

This control scheme can be easily adapted to control 
forces on the end effector. This capability will be 
crucial in applications of parallel mechanisms such as 
assembly tasks or partial/zero gravity simulators. 
The force control capabilities of the above control 
scheme also needs further investigation. 
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Appendix A 


r a position of the origin of the top coordinate 
system in the fixed coordinate system. 



Figure al. Free body diagram of the lower part of 
limb. 


F i3z 



Figure a2. Free body diagram of the upper part of the 
limb. 

Given the position of the coordinate system attached 
to the top member and its orientation, the position 
vector of the ith joint on the top member, in the fixed 
coordinate system can be computed by 


Si= bR t‘qi + r 
where 



Cosy CosP 
Siny CosP 
-SinP 


-Siny Cosa + Cosy Sinp Sina 
Cosy Cosa + Siny Sinp Sina 
CosP Sina 


Siny Sina + Cosy Sinp Cosa 
-Cosy Sina + Siny Sinp Cosa 
Cosp Cosa 

l qi = position of ith joint in the top coordinate 
system. 


The vectors along the limbs in the fixed coordinate 
system are given by: 

>i = Si - Pi 

The limb lengths are the magnitude of this vector 



For each limb, a coordinate system attached to the 
limb is setup. The limbs will be assumed to be 
axisymmetric. The z-axis for the new limb 
coordinate system is along the limb. The x-axis is 
perpendicular to the z-axis of the limb coordinate 
system and the x-axis of the fixed coordinate system. 
Thus the rotation matrix is given by: 



0 

^ix^iy 

liz 

1 


lixliz 

hy 

H- » 
1 

7 

_ 


where 

lix, Hy, liz = components of the vector li. 

The velocity of the ith joint is given by: 

t s i = t v+ t ojx t q i 

where 

l v = velocity of the center of mass (coincident with 
the origin) of the top member, 
ko = angular velocity of the center of mass of the top 
member. 

The velocity of the ith joint in the limb coordinate 
system is: 


where 

ll R t =1 ‘Rb b Rt 

In the following section, all the variables are in the 
limb coordinate system. The superscript is avoided 
for clarity. 
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The angular velocity of the ith limb in the limb 
coordinate system is given by: 


Six 

fiV = 

U ty j 

The velocity of the prismatic joint is given by: 
i = Siz 

The required equations of motion of the bottom link 
are: 


1i2x — (jilx "*■ m il b il 1 )®ix b ill m ilgiy 

Ti2y = (jily + m il b ill) a iy + b ilFj2x + b ill m ilgix( a J) 


where 


Jilx = mass moment of inertia of the lower limb 
about the x-axis. 

Jily = mass moment of inertia of the lower limb 
about the y-axis. 


Six 

8iy 

=liR b 

o' 

0 

_Siz_ 


-g. 


coordinate system. 


gravity vector in the limb 


g = acceleration due to gravity (9.81 m/s^). 


a iy = CiiiFtf* + c n 2 

a ix = Ci2lFi3y + c i22 

i’i =c i3 iF i3x + c i32 
where 
c ill = 


(a3) 


li 


c i21 = ” 


J ily + J i2y + m il b ill + m i20i “ b i22) 

k 


c i22 =” 


J ilx + J i2x + m il b Ul + m i20i “ b i22) 

c [ m il b ill + m i2pi ~ b i22)]gix 

J ily + J i2y + m il b Ul + m i20i “ b i22) 2 

2m i 2ijt0iy(li ~ b i22) 

Jily + J i2y + m il b fll + m i2( 1 i ~ b i22) 2 
[ m il b ill + m i2(lj ~ b i22)]gjy 

Jilx + J i2x + m il b ?l 1 + m i2( l i “ b i22) 

2m i2 ii(0i x (li - b i2 2 ) 

Jilx + J i2x + m il b dl + m i2 ( Ji “ b i22) 2 
1 

c i31=— “ 
m i2 

F U + m i2Siz + m i2( 1 i “ b i22)(®U + w ?y) 

c i32 = 

m i2 

Fia = force from the actuator 


The equation of motion of the top limb are given by: 

m i2 [(li “ b i22 )®iy + 2ii0>i y ] = F i3x - F i2x + m^gj, 
m i2[ — (U — b i22)**ix — ^U®ix] = Fi3y — Fj2y 

+n>i2giy 

m i2^1i — Oi ~ b i22)(®ix ®iy )] = F, 3z — Fj2 z 
+ m i2giz 

J i2x«ix = — b i22 F i3y “ b i21 F i2y “ T i2x 

Ji2y a iy = b i22Fi3x + b i2lFi2x “ J'i2y 

Ji2z®iz = Ti 3x (a2) 


where 

a ix> «iy, ai z = angular acceleration of the limb in 

the limb coordinate system. 

m|2 = mass of the upper part of ith limb. 

Ji2x» Ji2y. Ji2z = mass moment of inertia of the 
upper part of ith limb about its center of mass. 


The angular acceleration in equation (a3) are related to 
the acceleration of the top joint by the equation: 


-a i3y - 2^0)^ 

“ u ~ 

a i3x - 2iid)iy 
“iy = j 

l i 

Combining equations (a3) and (a4): 
a i3 = D i F i3+di 


where 


a i3 ~ [ a i3x a i3y a i3z] 

T 

Fi3 = [ F i 3x F i3y F i3z ] 



0 0 
~ c mk 0 

0 c i31 


(a4) 

( 35 ) 


Combining equations (al) and (a2): 


(b5) 


d i = 


Cii 2 li +2io) iy 

-cmk ~ 2ic0i, 

Ci32 - l(“u + <4) 


This matrices D; and dj in this equation can be 
computed for each limb. 

Appendix B 

The model for the two stage servovalves for small 
displacements is given by the block diagram in Fig. 
1 . 



Figure bl. Block Diagram of Row Control hydraulic 
servovalve ([8]). 

The flow through an orifice is given by the equation: 

Q = KAVpi — P 2 (bl) 


where 

Q = volume flow rate. 

A = area of the orifice. 

PI = pressure on one side of the orifice. 

P2 = pressure on the other side of the orifice. 

K = constant. 

For a positive displacement of the servovalve x s , the 
supply pressure is connected to chamber 2 of the 
cylinder and the return side is connected to the 
chamber 1. The equations are given by: 

Qin = K,x,y P , -p 2 + K^pj - p 2 ) (b2) 

Qout = K «X»VPl ~~ Pr — ^l(Pl — P 2 ) (b 3 ) 

These flow rates are equal to the corresponding 
volume changes in the chambers. These change are 
given by: 


Qout 


• A t (bi + b 2 -1) dpi 
1 P dt 


Using the above set of equations: 

A 2 (l - 1^) dp 2 = K> | x> ^ p> - P2 - iA 2 

+Ki(pi-p 2 ) 


A i(b|+b 2 -l) dpi 
p dt 


— Kg|x g |-^Pi — Pr +IA1 


-Ki(pi-p 2 ) 

If x s is negative, then these equations are: 


(b6) 

(b7) 


A 2 (l-b 2 ) dp 2 
p dt 


= -K,|x,|Vp 2 -p r ~iA 2 


+K l(Pl _ P2) 

A|(b t +b 2 — 1) dpi 
P dt 


= K i |x,|Vp,-pi +LA! 


— K l(Pl — P 2 ) 


(b8) 

(b9) 


The above set of differential equations can be solved 
to obtain the pressure in the cylinder chambers. The 
force on the limb is given by: 

F u = P2A 2 -PiA!-ci (blO) 

where 

c = damping coefficient. 

This completes the development of the equations for 
the hydraulic cylinder. 


Qin 


= iA 2 + 


A 2 (l- b 2 ) dp 2 
P dt 


(b4) 
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